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RESIDUAL FORM METHOD 
TO COMPUTE p q AND p u 


DIRECT FORM METHOD 
TO COMPUTE q AND u 


1 . COMPUTE THE FIRST KINEMATICS 
CALC. AND THE FIRST KINEMATIC 
RESIDUAL pq(k) 

2. GENERATE t(k), THE SPATIAL LOAD 
BALANCE FOR EACH BODY 

3. COMPUTE DYNAMIC RESIDUAL p u (k) 


1. COMPUTE q USING JOINT 
SPECIFIC ROUTINES 

2. PERFORM FIRST KINEMATICS CALC. 
WITH u = 0 

3. GENERATE RESIDUALS p u 
AND NEGATE p u = -p u 

4. PERFORM SECOND KINEMATICS CALC. 

5. COMPUTE u USING FORWARD 
DYNAMICS 



COMPARISON OF METHODS 
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ANALYTIC JACOBIAN METHOD 



1. COMPUTE THE ANALYTIC JACOBIANS OF THE KINEMATICS ROUTINES: 

8(Wu) 

Jqq =_ a^" AND J QU = W 

2. COMPUTE z £-M- 1 Pu (q. u, 0) USING THE DIRECT METHOD 

3. COMPUTE THE ANALYTIC JACOBIANS OF THE DYNAMICS RESIDUAL ROUTINE 

JL pu(q. u, z) AND _ip u (q. u, z) 
dq du 

4. BACKSOLVE FOR THE ANALYTIC JACOBIAN OF THE DYNAMICS ROUTINE 
USING RESULTS FOR z FROM THE SECOND KINEMATICS STEP: 

du A dp u (q, u. z) du 3p u (q. u, z) 

Juq = ^=-M" 1 AND J uu = £ = -M~ 1 — ^ 
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PERTURBATION 



FIG. 7 



